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Abstract: 

Abstract of EP 1205732 

(A2) The system has a inertial unit with an integrated GPS receiver or similar, 
this unit having Kalman filter members for combining the data coming from the 
inertial unit and from the GPS receiver. This unit has a first (K1) and second (K2) 
Kalman filter, each combining the inertial unit data and the GPS data between 
themselves, these two filters using different algorithms, different processors and 
different compilers. 
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(54) Centrale inertielle de navigation comportant un recepteur GPS integre 



(57) L'invention concerne une centraie inertieiie a 
recepteur GPS ou analogue integre destinee a fournir 
un vecteur d'etat d'un engin voiant, cette centraie com- 
prenant des moyens a fiitrage de Kaiman pour combiner 
ies donnees provenant de ia centraie inertieiie et du re- 
cepteur GPS ou analogue. 

Cette centraie inertieiie comprend un premier (K^) 



et un second (K2) filtres de Kaiman, chacun d'eux com- 
binant Ies donnees de la centraie inertieiie et Ies don- 
nees du recepteur GPS ou analogue, Ies deux filtrages 
de Kaiman utilisant des algorithmes differents, des pro- 
cesseurs differents et des compilateurs differents. 

Les donnees fournies par cette centraie inertieiie 
sont tres fiables. 
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Description 

[0001] L'invention est relative a un appareil destine a 

fournir un vecteur d'etat d'un engin volant. 

[0002] Elle concerne plus particulierement une cen- 

trale inertielle de navigation qui integre un recepteur 

GPS. 

[0003] Le vecteur d'etat d'un engin volant est un vec- 
teur representant la position dans I'espace de I'engin, 
son vecteur Vitesse en trois dimensions et les attitudes 
de I'engin, c'est-a-dire le roulis, le tangage et le cap. 
[0004] Une centrale inertielle de navigation fournit un 
vecteur d'etat. IVIais les donnees obtenues avec une tel- 
le centrale inertielle n'ont pas toujours une precision suf- 
fisante. En particulier, on sait qu'une centrale inertielle 
presente une derive et qu'au bout d'une heure de navi- 
gation, I'erreur sur la position est de quelques centaines 
de metres. Cette precision est insuffisante pour certai- 
nes applications, notamment quand un avion doit voler 
a basse altitude. Pour ameliorer la precision sur la po- 
sition, on fait appel a un recepteur GPS ("Global Posi- 
tioning System") qui, defagon en sol connue, determine 
la position de Tavlon k partir de signaux fournis par des 
satellites en orbite terrestre. La precision sur la position 
fournie par un recepteur GPS est de I'ordre de quelques 
dizaines de metres. Cependant, un systeme GPS ne 
peut pas etre utilise seul car il est tributaire de la position 
de I'avion par rapport aux satellites et I'engin peut se 
trouver dans une position ou il ne peut capter les si- 
gnaux des satellites. C'est pourquoi, on fait appel a des 
centrales inertielles de navigation integrant un recep- 
teur GPS. 

[0005] La combinaison ou hybridation des donnees 
fournies par un recepteur GPS et par la centrale iner- 
tielle de navigation est obtenue par un filtrage de Kal- 
man. On sait qu'un filtrage de Kalman est un algorithme 
permettant d'obtenir la meilleure estimation de chaque 
composant d'un vecteur d'etat. 
[0006] Bien qu'une centrale de navigation combinee 
a un systeme GPS fournisse, pour la plupart des appli- 
cations, un resultat fiable, cette fiabilite n'est pas suffi- 
sante pour certaines applications. II en est ainsi, en par- 
ticulier, quand I'avion vole en pilotage automatique a 
tres basse altitude et a vitesse elevee. Le pilotage auto- 
matique conslste, notamment, a determiner la position 
detectee de I'avion par rapport a une carte memorlsee 
et a plloter automatiquement I'engin de fagon a eviter 
les obstacles indiques par la carte. 
[0007] Le faible degre de fiabilite associe au filtre de 
Kalman a pour origine le fait que les logiciels correspon- 
dants sont developpes a I'aide de metliodes normali- 
sees, telles que la methode RTCA-DO-178B niveau C. 
Pour augmenter la fiabilite, 11 serait necessaire de faire 
appel au niveau A de cette metliode, mais celle-ci n'est 
pas compatible avec le caractere non-deterministe des 
f litres de Kalman. 

[0008] L'invention concerne done une centrale iner- 
tielle de navigation integrant un recepteur GPS dans la- 



quelle la combinaison des donnees fournies par la cen- 
trale a inertie et par le recepteur GPS est realisee par 
filtrage de Kalman et dont le degre de fiabilite associe 
au vecteur d'etat est eleve. 

5 [0009] A cet effet, la centrale inertielle integrant un re- 
cepteur GPS comprend, selon l'invention, deux filtres 
de Kalman presentant des algorithmes differents et ins- 
talles dans des processeurs distincts et differents avec 
des compilateurs differents, et des moyens de compa- 

10 raison des donnees fournies par les deux filtres de Kal- 
man, les donnees etant validees si elles sont coheren- 
tes, des mesures desecurite etant prises si elles nesont 
pas coherentes. 

[0010] L'utilisation de logiciels dissemblables instal- 
'5 les sur des processeurs distincts et de nature differente 
avec des compilateurs differents augmente sensible- 
ment la fiabilite puisqu'ainsi les erreurs ou pannes des 
logiciels seront aisement detectees grace a la compa- 
raison. 

20 [0011] II est a noter ici que par recepteur GPS, 11 faut 
comprendre un recepteur qui determine une position en 
fonction de signaux regus de satellites. Ainsi, l'invention 
n'est pas limitee au systeme GPS proprement dit ; elle 
s'applique a des systemes analogues tels que des re- 

25 cepteurs pour le systeme GLONASS ou le systeme 
EGNOS. 

[0012] Dans un mode de realisation, le premier filtra- 
ge de Kalman est du type a axes satellites et le second 
filtrage de Kalman est du type a axes geographiques. 

30 [0013] Dans un mode de realisation, le premier pro- 
cesseur est celul de la centrale inertielle et le second 
processeur est celul du recepteur GPS. 
[001 4] La coherence entre les resultats fournis par les 
deux filtres de Kalman est assuree quand, pour chaque 

35 coordonnee du vecteur d'etat fournie par le premierfiltre 
de Kalman, la coordonnee correspondante fournie par 
le second filtre de Kalman se trouve dans I'intervalle de 
conflance associe a la coordonnee fournie par ce pre- 
mierfiltre et, reciproquement, la coordonnee fournie par 

40 le premierfiltre de Kalman se trouve dans I'intervalle de 
conflance associe a la coordonnee correspondante 
fournie par le second filtre. 

[0015] AInsI, l'invention concerne, defagon generale, 
une centrale Inertielle a recepteur GPS ou analogue in- 

45 tegre destlnee a fournir un vecteur d'etat d'un engin vo- 
lant, cette centrale comprenant des moyens a filtrage 
de Kalman pour combiner les donnees provenant de la 
centrale Inertielle et du recepteur GPS ou analogue et 
cette centrale inertielle est caracterisee en ce qu'elle 

50 comprend un premier (K.|) et un second (Kg) filtres de 
Kalman, chacun d'euxcombinant les donnees de lacen- 
trale inertielle et les donnees du recepteur GPS ou ana- 
logue, les deux filtrages de Kalman utilisant des algo- 
rithmes differents, des processeurs differents et des 

55 compilateurs differents. 

[0016] Dans un exemple, le premier filtre de Kalman 
(K.|) fait appel a un algorithme a axes satellites et le se- 
cond filtre de Kalman (Kg) fait appel a un algorithme a 
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axes geographiques. 

[0017] Dans une realisation, le premier filtre de Kal- 
man fait appel a un processeur de la centrale inertielle 
et le second filtre de Kalman fait appel a un processeur 
du recepteur GPS ou analogue. 5 
[0018] De preference, la centrale inertielle comprend 
des moyens pour comparer les donnees fournies par 
les deux filtres de Kalman et pour valider les donnees 
fournies par au moins I'un des filtres quand les donnees 
ont des valeurs proches et pourfournir un signal d'indi- io 
cation de panne quand les donnees sont eloignees. 
Dans ce cas, 11 est avantageux de prevoir des moyens 
pour associer a chaque coordonnee du vecteur d'etat 
fournieparchaquefiltrede Kalman un intervallede con- 
fiance tel que la coordonnee reelle se trouve avec une 
probabilite elevee a I'interieur de cet intervalle, les 
moyens de comparaison determinant si, pour chaque 
coordonnee fournie par le premier filtre de Kalman, la 
coordonnee correspondante fournie par le second filtre 
de Kalman se trouve dans I'intervalle de confiance as- 20 
socle a la coordonnee fournie par ce premier filtre et si 
la coordonnee fournie par le premier filtre de Kalman se 
trouve dans rintervaiie de confiance associ6 a la coor- 
donnee correspondante fournie par le second filtre. 
[0019] D'autres caracteristiques et avantages de Tin- 25 
vention apparaTtront avec la description de certains de 
ses modes de realisation, celle-ci etant effectuee en se 
referant aux dessins ci-annexes sur lesquels : 

la figure 1 est un schema d'une centrale inertielle 30 
integrant un recepteur GPS conforme a I'invention, 
et 

la figure 2 est un schema expliquant une etape du 
fonctionnement de la centrale representee sur la fi- 
gure 1 . 35 

[0020] L'exemple de I'invention que Ton va decrire en 
relation avec les figures concerne une centrale inertielle 
IN et un recepteur GPS utilises pour le pilotage automa- 
tique d'avions, notamment a tres basse altitude. 40 
[0021] Cette centrale inertielle hybride fournit un vec- 
teur d'etat forme, d'une part, des trois coordonnees de 
la position de I'avion, ou engin volant, integrant la cen- 
trale hybride, d'autre part du vecteur Vitesse a trois di- 
mensions de I'engin volant, et d'autre part enfin, des at- 45 
titudes de I'avion, c'est-a-dire le roulis, le tangage et le 
cap. Les coordonnees de position et le vecteur Vitesse 
sont fournis par la centrale inertielle et par le recepteur 
GPS tandis que les attitudes de I'engin volant sont four- 
nies uniquement par la centrale inertielle. so 
[0022] L'hybridation des donnees fournies par la cen- 
trale inertielle et le recepteur GPS est obtenue par fil- 
trage de Kalman. 

[0023] Pourfiabiliser les donnees fournies parfiltrage 
de Kalman, c'est-a-dire pour accroTtre la confiance ss 
qu'on peut accorder aux donnees fournies par la cen- 
trale inertielle a recepteur GPS integre, on fait appel a 
deux filtrages de Kalman correspondant tout d'abord a 



des algorithmes differents, a savoir, dans l'exemple, un 
algorithme a axes satellites et un algorithme a axes geo- 
graphiques. 

[0024] Ainsi,commerepresentesurla figure 1 , lacen- 
trale inertielle a recepteur GPS integre 10 comprend, 
d'une part, un calculateur 12 de mesure des vecteurs 
d'etat fournis par la centrale inertielle et, d'autre part, un 
recepteur GPS comportant un calculateur 14 des vec- 
teurs de position et de vitesse de I'engin volant. Au cal- 
culateur 12 est associe un processeur 16 dans lequel 
est installe un algorithme de Kalman K., du type a axes 
satellites qui fait appel, d'une part, aux donnees fournies 
par le calculateur 12 associe a la centrale inertielle et, 
d'autre part, aux donnees du calculateur 14 du recep- 
teur GPS et qui delivre sur sa sortie un vecteur d'etat 
qui est applique sur la premiere entree 1 8 d'un compa- 
rateur 20. Dans une realisation, le calculateur 12 et le 
processeur 16 torment un seul processeur. 
[0025] Dans le processeur 22 associe au calculateur 
14 du recepteur GPS est dispose un second algorithme 
de Kalman K2 du type a axes geographiques qui revolt 
ses donnees, d'une part, du calculateur 14 de coordon- 
nees GPS et, d'autre part, du calculateur 12 fournissant 
le vecteur d'etat calcule a partir de la centrale inertielle. 
Les donnees fournies par le filtre K2 sont appliquees sur 
une seconde entree 24 du comparateur 20. Dans une 
realisation, les calculateurs 12 et 14font appel au meme 
processeur. 

[0026] Pour assurer une fiabilite maximale, les pro- 
cesseurs dans lesquels sont installes les filtres K., et Kg 
sont distincts et d'une nature differente. En outre, ces 
processeurs utilisent des compilateurs differents. 
[0027] Les donnees fournies par les filtres de Kalman 
K.| et Kg sont comparees (bloc 20) de la fagon suivante : 
a chaque coordonnee Xj,^., du vecteur d'etat fourni par 
le filtre K.,, est associe un intervalle de confiance 30 (fi- 
gure 2) qui est constitue par I'ensemble des valeurs 
comprises entre Xj^^-r et Xj^i+r. L'intervalle de confian- 
ce est determine de fagon telle qu'il existe une probabi- 
lite elevee, par exemple superieure a 99,9%, que la 
coordonnee reelle soit a I'interieur de cet intervalle de 
confiance. 

[0028] De meme, le filtre Kg fournit pour la meme 
coordonnee une valeur Xj^g a laquelle on associe un 
intervalle de confiance, c'est-a-dire un ensemble de va- 
leurs comprises entre Y-y^-f et Xj^g+r'. 
[0029] Le comparateur 20 determinesi lacoordonnee 
X|K2 se trouve a I'interieur de l'intervalle de confiance 30 
et si la coordonnee Xj^i se trouve a I'interieur de I'inter- 
valle de confiance 32. S'il en est ainsi, les donnees es- 
timees sont fiables et disponibles et on valide celles 
fournies par au moins I'un des filtres. Par centre, si le 
crltere de comparaison mentionne ci-dessus n'est pas 
satisfait, les donnees sont estimees d'une fiabilite insuf- 
fisante. En outre, I'incoherence entre les donnees four- 
nies par les deux filtres est une indication de panne. 
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Revendications 

1 . Centrale inertielle a recepteur GPS ou analogue in- 
tegre destinee a fournir un vecteur d'etat d'un engin 
volant, cette centrale comprenant des moyens a fil- 5 
trage de Kalman pour combiner les donnees prove- 
nant de la centrale inertielle et du recepteur GPS 

ou analogue, caracterisee en ce qu'elle comprend 
un premier (K^) et un second (Kg) filtres de Kalman, 
chacun d'eux combinant les donnees de la centrale 10 
inertielle et les donnees du recepteur GPS ou ana- 
logue, les deux f iltrages de Kalman utilisant des al- 
gorithmes differents, des processeurs differents et 
des compilateurs differents. 

15 

2. Centrale selon la revendication 1 , caracterisee en 
ce que le premier filtre de Kalman (K.,) fait appel a 
un algorithme a axes sateiiites et ie second fiitre de 
Kaiman (Kg) fait appel a un algorithme a axes geo- 
graphiques. 20 

3. Centrale selon la revendication 1 ou 2, caracteri- 
see en ce que le premier filtre de Kalman fait appel 
a un processeur (1 6) de la centrale inertielle et le 
second filtre de Kalman fait appel a un processeur 25 
(22) du recepteur GPS ou analogue. 

4. Centrale selon I'une quelconque des revendica- 
tions precedentes, caracterisee en ce qu'elle com- 
prend des moyens (20) pour comparer les donnees 30 
fournies par les deux filtres de Kalman et pour va- 
lider les donnees fournies par au moins I'un des fil- 
tres quand les donnees ont des valeurs proches et 
pour fournir un signal d'indication de panne quand 

les donnees sont eloignees. 35 

5. Centrale selon la revendication 4, caracterisee en 
ce qu'elle comporte des moyens pour associer a 
chaque coordonnee du vecteur d'etat fournie par 
chaque filtre de Kalman un intervalle de confiance 40 
tel que la coordonnee reelle se trouve avec une pro- 
babilite elevee a I'lnterieur de cet intervalle, les 
moyens de comparaison determinant si, pour cha- 
que coordonnee fournie par le premier filtre de Kal- 
man, la coordonnee correspondante fournie par le 45 
second filtre de Kalman se trouve dans I'lntervaiie 

de confiance (30) associe a la coordonnee fournie 
par ce premier filtre et si la coordonnee fournie par 
le premier filtre de Kalman se trouve dans i'lntervai- 
ie de confiance (32) associe a la coordonnee cor- so 
respondante fournie par le second filtre. 



55 



4 



EP 1 205 732 A2 



IN, 













QPS 











^10 



.18 



Li- 



FIG.1 




FIG. 2 



5 



